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mm] v-^<D%mmm^'o^< . iM9Pftji& 

JW««5RLJ=»-t-4*ttffiffiai3RC©FIB*3eifttTJ>J L A 
*Mfi»(iS-e:fc»T?BHMetllfTjiJS:f^fifcU. fill. £ 
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Wm^kt. WET— AXjS^bl3teB8B9i4: y v^coM 
^;b-t*:£'>ft< t fc— 3ttK±*tebfcT— , 
^T-A#S(D^^-ffi^@febflfeffi(i^rff^^r-- 

«S:gff^fflPiBffi«fi:K^Wi3t L tifflm* << — Steffi 
fE*?FJg * -< — /u t iKrlE !7 — ^ *s jf ^ t ft < 

^^It^fil^tt^ii^t^t Ltl*(6|i:i|[H] 
fflSSrltflESit* t ii:Aft*rRi(3B:j»ie»i-5» 2 Mi&SSn 

t r KT— A^S(05feSH(c--iBS:HSUtei(»fi!7 — 

^m^cD^mmmiiLm^^ l fc*«<^flF* * -y 

— ^ £ it ^ . mffSWS * -Y /i^ t Buffi !7 — ^ #s J¥JE-*- -5 



(2) »HSp 9- 1 0 3 9 4 5 

2 

HffEflFfi* -Y -A- <t mjfB [7 — * Pfld Jp * 5 JilkXFe — ^ 
3. *K:<fc 9 HufEW®^-<— yu^L< fiBtflE 17 — ^ «: 
IiS l^ftKJS LfcflMEWt * -Y -/i/ 4: fitffS V — 

EtS r < Lfc«»tR« * Jx5tDJIII«* 

^ «r *f 5 ml ffilgteffi JR-t* 5 mffoMMZk (DiiLWR 
»fi:3Sllc3E*f-rs**y«iHiJ#S4:. «TlBW**-f — /u* 

^ 4: t -f S 4 E«t09LA«F«»C 

30 [0 0 0 1 ] 

PJ"T6 0 
40 [0 0 0 2] 

# *5 * T'tr o T *3 5 * rt: g » f b $ tiT ^ ft V \ 5JFJ^ 

fi©^$i2^^^^PB E I&a^$ftX^tLTl^ 0 WS* 
-Y -y^ 1 Cl^PIF B ^itt 4 H#f+^iS^— ^ 3 SriK 
^-r^fc^cQ^u— h 4 35SK*t6>tLTt^ 0 fit, r 
h 4 tt, /u- h 4 ^BfEffifltRV»» ?r 
7 &7L h tzftcv* i? 5 a . 5 b SrP54B^-t*S ^ h r 
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[0 0 0 3] Jto^£«/*<0 f£H#tt«T<B«Kffl 
[0004] 

[0 0 0 5] Sfc, ? — ^ ^tE^-r^-^^h: 0 ^ U — ^69 30 
I'&^Mtt), !S 5fe ft fc> n T # fc 9J » { r f i 3^ T O «t £ Pol 
H/^&o/c 0 g|l6(C*3l^T, a*L4l^^ 
^^•7 — ^ 2 1 SrffitSLT^So * L-T, Mxtf (a ) 
(Om^X^m^l [N] tfflfi*>f-/Hl:!7-^2 1 
SrWboJtft^C), (b) (D«tCY*r6]T*^!7 — ^ 2 
1 Sr^Sb^^rTWS-T^o (c) {i»iffil:gft^4i: 

(d) tiw*ffi^^k<^*C4ii-&jc, y — ^2i6og 
'>-f^y ^/ K»J»<!:i^fi4x"C^5^, X*|6j*c^fHW^ 
M$ix6: ttc*9 , y — ^ 2 l «DWf@Si-:^fto± 

[ 0 0 0 6 ] Jg(^ ±ff£'M':/y y K»J»tt«4(t4fif^J 
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[0 0 0 7] 

Sir, WET— AS^bEWteBBflSt y >^co*a*-&;fo 
£ 1— »£JL-hJSttU3tT— ^^St, f*T— 

^ — ^^lixTffi^; Ltc 0 
[0 0 0 8] Sfe, #*§H (if*iB2) tt, IHS^C 

^-b®*£L^T-^^S^, i7-A^t^ffi[:-S 
«t5i£*ME»^r6l % «TE*2iai&Bias#®JcJ:Sil:j||K 

t mzmwM&&mm ^ifcxi, Yifiu« z u 

[0 0 0 9] 5Eid, (W*3S3) fi, ffiW^^C 
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^^m.mmm't^msm.mmm^t. mmmsmmm 

i o o i o] (ts*ii4) tt, mm&4- 

tv^ t < fitssFS^ ^ -/k-jbe^-t a c <t k & y mm $ 
n ^ 7 - * if mm t mmmm *^-^t mm u 

mmmj&&&-&k t^-v^t 0 ^ ^—p^fommmm* 
* —>\,m l < ttwia !7 - ^ $ -erwsfm & fx 5 #l 

^tg^s^ffi £ itufewjg* -r — t mm y—? bo^wbe 

VSSWSrSeiSr fcTWIBBF**:^— ^«U< ttS9IE!7 
V * £ <5 # Htj 1 5 <r =- tT a u - ^ co 5fe ffi e 2ft g? ^ 
[001 1J II:, (fjf*«5) ti, fltFte^S^ 

<om»j3 1 . %%wmt)i)^7L btitzi&%:&.-rz>&tiLkfr 

[0012] 

*3t fg ] ffWHtfin 1 1 tt* 1 BIAS :i 2 SrffifflllS^O 



a t<z>-e*2ii:sBiB8-as^a(rt@a+4o » 3 isisbEaffB 1 

5 liSS 2 BSffii 1 4 *8£r3fct* £*u ftfeSB^JR ;i mtega 
SSI 6SrZ 2 ^Jf^{:li:^IE!li)-r^ tcox-T — ^S/SiEBb 
#a«:*B^-rSo ^ 1 EIlEBifflS 1 6co^^^T-AS^, 
l 6 al:ftSt5 0 JSlBCftBBttl l . fR2XnE8ffl 

6 a mi V 1 7 A<0— flB^H^Six, * 1 y 

>^ 1 7A<ote*Ktt*2ig(EBBtti 8HriS2y>' 
i7B^te4H«:tt, m3^iumBi 9^^l*3 y 

b, *3meB8fl5i 9Ai/*3 y >^ i 7coa^ 
* i m^ESfls i6, 12 0te^gn i 8»t;» 3 mfeBSfifi 

20 —^21 l:x«Lt, EWto*Ji2^gFf^<!03SBBffi««r«i3t 
^1 0^, ±SEUfc«Hr6B8»Sr#-#-*btfAi:PI«^tt 

[00131*1 fitbfflgp IK 12 EfbHaHS 1 3 

30 ^ 0 Xz . YzMZz tt. m&mmMx-foz>&&m± 

l, *2iMbBlgni 3XO«*3ie»Ba«i 5tt, Xz . 
Y z Ft>7z ^^i-^ai^dr^T^-^r^^^^^o 

l l , w- * co g ^%it l * ttn mteBSffl -c#?^. t r 

^3*{:(5gfei-^» - k t>«^o ISM-fttC^f tt¥ 

40 [0 0 14] ^ 1 OOftJfiJlCo^T 

f^PJ-T^o ^t^U^lOli W*.ffH'2«w*-r« 
ft!7 — 9 2 1 (O^ffJ^atLWSiftfPSrfi 1 5 0 WS»f^ 
M= (Mi . M 2 , • • , Ml , • • , Mn ) tt!7 — ^ 
2 1 OW«B5^«N«C»U-CN«aS*t5e«*ixS 0 # 
«Fe»-^Mi fi^WJS^n— SrBI3f^i- 0 -^ne^u— 
^ 1 Ott. WfilffM, . M 2 , • • ^co«i:^7-^ 2 

— * i o\±v—$ 2 1 (ommm^oym&^mmt^^ir 

50 «4»-&CfiM 1 T*ffiiff2iU«tta:firoT*5# % ^QYik 



7 

(DwmmmzmjsL'tZ) -k&< mm ltit ? 0 ^lt, 

[0015] t^^>X\ -^^t°^ 1 O^^K^PJx 

{4ffiig?0££*H-f-5fc f£E^2o^MM^^il 
4X4tT?iJ (J£*T\ fRj^f^fT^J^^^o ) T**i" 0 El 

^I^^^T^T^ bfc h<D T*&3 0 Px , Pv , Pz 
^i~o n x , n Y ♦ n z . o x , o v , o z , 

#t5Dlf^(7)M^^to — 04 -t? D Ac te, 
[00 1 6 J *^SRI«P*»ff3?iJ«r*iJfflUT. !7 — * 2 

z Al £:^£;h,3 0 

[00 1 7] «ill/<7i/-^S:ttfflU5ff* 
-f — yui i: !7 — ^ 2 1 BflK:, ? — ? 2 1 fRy^H^bTtS 

[d™, dpv, dn] 7 =diag [K x 

(fit, 

me] 

Kx =K,aKi, • S d t tL« • d/d t 
K y = K py +K iy • Sdt+K dy - d/dt 
K. = K Ba -rK 5 , • Sdt+Kd,' d/d t 
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^»(ttUT^4B#, 2 1 «g7^^ 

»ffiis^c js, fc t t <©-wffljffi«* l t -rns:* c 

5 0 C09B#^^S^[U6 (B) d^i". :^fiffi{;g 

57-* 2 l oSliffilSS c L i:» t 

y b<Dfg^mj£ffek : ffim*'<— ;H 17 — ^ 2 1 BBcoif 

20 Fr = [Fxr, Fvr, fzr, Mx r , My r , Mz,] T 

[$2] 

P = [F x , F Y , Fz , Mx , My , M z ] T 

[0018] 
[*3] 
30 Er =Fr - F 

= [Er i3 Em, Erz, Emx, Emy, EmzJ t 

l: J: o T*jE SJlSffilSVS^Rl^^ h 

[S4] 

dX= [dpx s d r >, dr 2 , d M x, d MY , d MZ ] T 

It, 

40 [&5] 

, Ky , K 2 1 [Efx, Efv, Efz] t 
I*7J 



(6) 
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Eo - [dnx s d m y , d MZ ] T = [ 



fiU r{2^ 

[ooi9] m t {zmm^m&iimmim^ corner ^ 

££l>*{t ft fc^ic BIBfflJf Sr%fiR-f 5 s6J*tf s fo*>tz.tibX 

Eo = diag [K B x, Kov, K*z 



*tfc#* SMS/- h 2 75S6*#fl8) o 
[0020] ron*. y > hfBI»BUfi, 

[tfc8] 

] [Emx, Ehy, Emz] 7 



fiU 

K n,x = K mp* 
K Dy =Kapy + Koiy 
Kbi - Knpi + Koii 



S d t + K»d« 
S d t +K.d, 
S d t + K. d . 



d/d t 
d/d t 
d/dt 



x I n e q Li a 1 
and Contr 
1 9 9 4) ftko 



20 



yd "Linear Matr 

ities in System 

o 1 Theory S i a m, 
[0 0 2 1 1 S7, §8 RZffl. 9 <Dfe$k&i> £ 1 0 
Rim 1 ltrt^t £r*ft, ^^C^t^MiM 
T?&\9k 1 2 Srf#5 0 {Mb. Cfic o s CO, S s in 

vf± i - c o s commt-r^o 
m i o i 

I dM t = (dM* 2 + dM„ 2 +dM, 2 ) 



EJLJb^WlttP I D*J»*-e«*^ ^l(:ecttt(Z)7!i 
^JXASrttffltari: ( J . C. Doyle 

"State — Space Solution to 
H2 andHoo Control Problem 
s IEEE Transactions on A 
utomatic Control. Vol. 34, N 
o. 8, pp. 8 3 1 - 8 4 7, 1 9 8 9. S. Bo 

rx =dMx / I dM I , r y -dM y / |dM|, r, =dM,/|dM| 



fib. | d M | ^ 1 

£• I dM | t?«s 0 
[ftn] 



dMv 



d M z 



s i n 0 = | dM 



0= s i n" 1 | dM I ( 0 ^&^tt/ 2 ) 
* [ft 1 2 ] 



L Ac = 



-rx • rx * V^+C^ r* -r y -V^-r, rx - r* -V^ + r r -S0 

rx • r y • V0+r, • S # r y • r , - V^ + C^ r y ♦ r , ■ V^-r K - S ^ 

rx • r , - V - r , - S • r » • V^Tn - Stf r * * r * • V^ + Ctf 
0 0 0 



ci rx m 

d FY 

drz 

1 - 



LfcAHKK^-^^ h»J»Bi]K:*<5f\ {DXMUffi^ 40 

[ 0 0 2 2] ftfr, E7 — ^ 2 1 ^JKttXU«!7 — ^ 2 1 _k 
(ffi) figE*o£ U (B5) SrW** 

i- 5 fc ft to«ftbffijffi«* c /i^fi L ae $ ix s ^s . -tJ r*«« 

B5ffi«^C(^-T5I7 — ^ffi«^WS: C A W T-^ft-T 

5 0 7 — ^ffi«SWfi, Wxtf7-^ 2 :i co^^/cfEits so 



8 (a) i-r^t-o »ttffijaiai3Rc«cst-t-5 y — ?wm?k 

W<DEHE« b < tt3fcit*c i 5 ttMS^^fbS b < ttiste 
^•^fe b, ISfiliijM:^^ cii:<;):^ a> hW>W)%i b < lis 
tei"* 0 WSBBteSSfiEls (B) (ciF-r^ir^ft-^^ 

ttcSMti^ c fit? b^ 0 wmmtemm&mmmmrrw t 

[0023] jfctw, -v^f^ :i o^dta 
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v - ? n^wc *r-r 5 t° ^ i — $ ttws&k r co 

[«l 3] 

* A b —pi 0 0 -6 0 n 

0 10 0 

0 0 1 7 9 

L 0 0 0 1 - 

sett, Jt3£lttlEl9^7 — ^Jffi«*WS:tt/MlHg 
[0 0 2 4 ] H9tt, !7 — * 2 1 Sr^fWK'jr— * 3 £ 

it 3 (Mid o :*7-^Ig^W^)ltIlSSC 

(Miw ) o f^Sl 0mmYwtt*|6ji^^tb$^r (M 
ih 2 ) , 1 Ommlt (Miha ) o tit, ^Stt*T 

6^[E]^$it5 (M ah4 ) a ft±Jj®mtmmfci om 

mYw tt-^-f -t-^^lRl«-^»l$i^ (Mihs ) . 1 0 mm 

m-r (Mih« ) o -t^a. s&fes-ttrfcs-szw toum- 

ih7 ) , gtJ3fc£-£5 (M ld ) 0 ^^-6»tt*tt-C(^ia«F 
mWfrn (Mihj ( j = l ~ 7) ) lifti4 0«li*S 

[ 0 0 2 5] 
[f 14] 

c Au (j = 1-7) = rcosa — sina 
ina c o s a 



' — 0 
y 1 0>y 1 0 



C - r 
C y 1 
1 0 



im i ] 



10 



20 



3 


r (mm) 


( 

a (deg) 


y I (mm) 


1 


1 2 


0 t o 1 8 


0 


2 


1 2 


1 8 


0 t o 1 0 


3 


1 2 


1 6 


lOtoO 


4 


1 2 


1 8 t o- 1 8 


0 


5 


1 2 


- 1 8 


Oto-10 


6 


1 2 


- 1 S 


-1 0 t O0 


7 


1 2 


— 1 StoO 


0 



?'J L A C S:3S?k3E*fbT^<©J»i:, ^- y ylI^W(; 
ffiB. g?», V hSrlRl^lcjRHEffiiJSil-t- 

sor-tt*< , #flfi»^»«iCiS i:fc*R^- 
[0 0 2 6] ? i oi:o# 4 W±^cfc 5 

[fl5] 

40 2 A r = z Al l Ac c A* w A r 

Ell 0(c^glM^S^^i-5/c^>, #lRlNpa*fTyjra^ 

^zwmmm&LcDfflm&Wfr&i z a l u—tmm 
w Ar tt, tswa^^^STfo^o f^oT. * 
mmm* l «3»-t-6««ffiffi*gR c toisi^aftffyij l a 
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Rcomv-mmm 2 a r **»ar.t*stb*, 
[oo2 7] 4*-e<DVLm\zm<5£ % &m<Dm&x<Djj 

C F t^Sri VJjRXfi*—* > h«^^ h/u C E F 
^r*^)5 0 t^a^-^ > hK^<* hvu c Ef 

xsrwta-rsc Am #«iHite«k&t5*fliiiHite*-c* 
* t «3S'*? * \z*t& i-tc^-^mn^ z s^i-s 

**3tffi*5RRORIWPSeilM??iJ Z A* Sr* 
*63 0 TT-ra«f«tftfT^ z Ar ^bOTS^D- 

B-*aixS:*t, J Q r #BaSS«i<o»»BSfii[S:^ 

x> i/fMkl «¥»D, 1 1 3#4^-, «5¥) m 
[0 0 2 8] WJWitft^-xyuPttmA^ 1 ttl*e*li* 

□ — tVf 3 — A T**-t\ T^-Ctj — fcf 3/ 5" 3 — ft 
n*h\vM&Wfi'&\ Z A KC — (D&lfc&'ll 0 0 NT', '-r^ fc° 
=■ t--^ ^Steffi** R ^bgttill^ C * T'^IrJR*-^ 
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'-Acc^^b'fifi&t^n— t° j/^- 3 — ft ^^fClftSrtT 

10 n fcr<o<E|ttT^J ( J sc T ) c -^SMSlfiX 

>5 0 r^^, (Jsc T ) tt-fe>1^ffi«»SS:Sftbfcii 
^c7)ir >1M^g^^ S 7^ ^gttffim^ C — coir =3 t^T^iJ 

[0 0 2 9] 11 2(1, ^fffi/^ h/^^-fevy-^iCj; 9* 

= t'fT?iJ^tegiS?ff?iJ (J C j T ) - l Sr»lt5rtt*S» 
®M^^C_bco^/3:t>'-e-^ > M^mJi^fit C F 

^tUM^fS: C F S:A«!l»»J^W«-r 5 r i -eScflSJc**!! 
m&'fro r 4r*sm*5o 2k t-, 113 (A) i:*^K<^ 
I2*fifl^, SfcBl 3 (B) tn*3BSJ3<^3H*fi 

^SrMLTSS^IHtSo 113 (A) (C*3^T. 

isntt^o ^0^3 1 o 2 ^bz z ^r^i^fru? 

«53 2>5SHK*ixT^5o * 2 KSbBifiS 3 3 1*. ft 1 r» 
«i 3 2 5HS:S:«pSnte«B^« 2^p34 ^riiO z 
Zz <bE^^^^izii:^Sb^^t>(DT^2Etjb^iB^ 

*Sr3£«p*4xteSH6Qftl[lHsBitt3 6SrSj»O z Z z t 

40 St5 0 Sl0»3 6^tt*l y >^ 1 7A(^?-« 
^^HAE^ti, Il!iy^ 1 7 A^ftb4B^ttft2EI(£B8fflS 
3 7 S:^U»2 !i>M7 B (O— *B^HS$4x-Ct 
[0 0 3 0] Sfc, B13 (B) 1^*51 Ml B9flS4 
2ttte«3<OiSElHl«i4 1 £r!£^O z Zz ^Ifil^iSjKffifti- 
5«i:ftot^5 0 ttlaltt4 1 tt, SSO z Z z S:*^ 

»2HjBi4 4tt, WUH^flfl l9lEBBflS3 6MI 
50 %rSU^^mfi7r^^#f^(c 



(9) 
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36ili^ii9-C?*>5o -^tr°^ 3 0Xtt4 Ofi, 

[0 0 3 1 ] ^<D%£%k. -&%L<DQtmfc 4 1 <^W^<D 

tii^JC^lt^lgfM^^iL, !7 — * 2 1 SIT 

So SttffiJii^cToMo^-^ > hti, 1 f - j 

JC T x C F£ 0 C F = ( J jc T ) "*x J FT^$ti5o 

[0 0 3 2] HI 4©iil:^f5De n a v i t -H 
a r t e n b e r g <7V*7 * — # S:*^* t #>S t * 2 

[*2] 



i 


ai-i 


a i-i 


di 




1 


0 


- 9 0 


y 


-9 0 


2 


L » 


- 9 0 


X 


9 0 


3 


0 


9 0 


-L, 


9 0 


4 


0 


0 


0 


0, 


5 


0 


9 0 


0 


e, 


6 


° ! 


- 9 0 


L, 


e 3 



16 



10 



20 



30 



40 



17 



- C0i 

s 6 i c a i-i 



(10) 

-s Ol 
c 8 i c a i-i 



& & i S OTi-i C 0i S tti-: 



0 

-Sflfi-i 

c 
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— s a i-i di 
c a i-i dt 

i 



^c^f^c^<tffi^LT^-t-5o fin^, mimmm [0033] 
in, m2m.mmmi 3 Rxrm 3 m.nn»i *s* tsi 7] 

-r 1 
r 2 

r F = r, 

T 4 

r s 

"f « 
*f » 

-e y c f, + e» fl f y + °m. 
-e. c0z °f* -e, sOi °f y + <e r sfl 3 +e. c0, ) c f. + c nu -c5 a c m 

a 3 + a, s f y + a 3 *f m - c^ c m. - s^ sOt e m, +c0, c m» J 

a i = - s 6 . sfij ( z + L, cfi 8 ) - c^ a (y-L, 3 0, s 0 3 ) 
a 2 = c6 2 (x-La c<9i s6 2 ) +c0! s 0 2 (z~L 3 c0i ) 



ffiU e x . e v . e= tt^ffi^^ h^Sr**-., ^<D&%k. 



*3, I 2 ISil^O'1 3 i^isi 3 1 , 4 1 

[ 0 0 3 4 ] ^ftttaSjr^if— ^<^J; 9 #B88fi 

Itm^f 1 8 
[ft 1 8 ] 



(11) 
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= ( J.c 1 ) - 1 J F 
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c f . 

c m x 
c m y 
c uiz -» 

- r 2 

r i 
r a 

di ri +d 2 Tz + d 3 r a 4- c 2 02 /hr* -s8i sOi /br,, -c0 2 /br. 
d4 r. + ds T 2 + d 6 r 3 4-s02 c^j /br* -cfli s^ 2 /br s -s0 2 /bT« 

— e» Ti — e y Tz +Ti 
d x =e y c 2 0 2 /b-et cSz s£i s^ 2 /b + a, c0 2/ /b 

d 3 = - e , s0 3 c^/b-e, s 0 2 cd, s 0* /b-f-a 2 s0 2 /b 



d * = ( e y s 02 te, cflz ) cfli s 0 2 >/b -+■ 
[0 0 3 5] 

[0 0 3 6] Sfc, #3593 (f»**B2) t?tt, 40 
EM**!::****** t ^ l *t l (DBBffi^* 9 *atMi 

[0037] Mir, #3gg! (it*^3) T*» % teia^e 



a 3 s 02 /b 

#a (- «t z> w.mmmjjfa t&WiJZ^xmf&LtzcDx. 

[0 0 3 8] Sid. (11*154) -ejs, 

[0 0 3 9] #389! <W#*B5) MOT 

!iZ£vm7E-tz>ffif&kistz<Dx\ h^?±>~y-m&mm 

[0 0 4 0] 

im i ] *mm<om 1 mmmnxfozmmmtr—* 
wmmwcoffif&m 

B2] as £*-r s ? - * 

mm [Hitetts t/^fffi e te a m 



[03] 
[04] 
[05] 
[06] 
[07] 
[08] 
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